home *** CD-ROM | disk | FTP | other *** search
/ Graphics Plus / Graphics Plus.iso / general / modelers / geomview / source.lha / Geomview / src / lib / geometry / hpoint3 / hpoint3.c < prev    next >
Encoding:
C/C++ Source or Header  |  1992-12-07  |  3.5 KB  |  172 lines
  1. /* Copyright (c) 1992 The Geometry Center; University of Minnesota
  2.    1300 South Second Street;  Minneapolis, MN  55454, USA;
  3.    
  4. This file is part of geomview/OOGL. geomview/OOGL is free software;
  5. you can redistribute it and/or modify it only under the terms given in
  6. the file COPYING, which you should have received along with this file.
  7. This and other related software may be obtained via anonymous ftp from
  8. geom.umn.edu; email: software@geom.umn.edu. */
  9.  
  10. /* Authors: Charlie Gunn, Pat Hanrahan, Stuart Levy, Tamara Munzner, Mark Phillips */
  11.  
  12. #
  13. /*
  14. **    hpoint3.c - procedural interface to 3D point geometry
  15. **
  16. **    pat hanrahan
  17. */
  18.  
  19. #include <math.h>
  20. #include "hg4.h"
  21. #include "point3.h"
  22. #include "hpoint3.h"
  23. #include "hplane3.h"
  24. #include "hline3.h"
  25. #include "transform3.h"
  26. #include "tolerance.h"
  27.  
  28. void
  29. HPt3Copy( pt1, pt2 )
  30.     HPoint3 *pt1, *pt2;
  31. {
  32.     *pt2 = *pt1;
  33. }
  34.  
  35. void
  36. HPt3Normalize( pt1, pt2 )
  37.     HPoint3 *pt1, *pt2;
  38. {
  39.     if(pt1->w == 1.0 || pt1->w == 0.0) {
  40.     *pt2 = *pt1;
  41.     } else {
  42.     float inv = 1.0/pt1->w;
  43.     pt2->x = pt1->x * inv;
  44.     pt2->y = pt1->y * inv;
  45.     pt2->z = pt1->z * inv;
  46.     pt2->w = 1.0;
  47.     }
  48. }
  49.  
  50. /*
  51.  * pt2 = pt1 * T
  52.  */
  53. void
  54. HPt3Transform( T, pt1, pt2 )
  55.     register Transform3 T;
  56.     HPoint3 *pt1, *pt2;
  57. {
  58.     register float x = pt1->x, y = pt1->y, z = pt1->z, w = pt1->w;
  59.  
  60.     pt2->x = x*T[0][0] + y*T[1][0] + z*T[2][0] + w*T[3][0];
  61.     pt2->y = x*T[0][1] + y*T[1][1] + z*T[2][1] + w*T[3][1];
  62.     pt2->z = x*T[0][2] + y*T[1][2] + z*T[2][2] + w*T[3][2];
  63.     pt2->w = x*T[0][3] + y*T[1][3] + z*T[2][3] + w*T[3][3];
  64. }
  65.  
  66. void
  67. HPt3TransformN( T, pt1, pt2, n )
  68.     HPoint3 *pt1, *pt2;
  69.     int n;
  70. {
  71.     while( --n >= 0 )
  72.     HPt3Transform( T, pt1++, pt2++ );
  73. }
  74.  
  75. /*
  76.  * Transform and project an HPoint3 onto a plain Point3.
  77.  * Transforms pin . T -> pout,
  78.  * then projects pout.{x,y,z} /= pout.w.
  79.  * Returns pout.w.
  80.  */
  81. HPt3Coord
  82. HPt3TransPt3( T, pin, pout )
  83.     Transform3 T;
  84.     HPoint3 *pin;
  85.     Point3 *pout;
  86. {
  87.     HPoint3 tp;
  88.     register HPt3Coord w;
  89.  
  90.     HPt3Transform( T, pin, &tp );
  91.     if(tp.w != 1.0 && tp.w != 0.0) {
  92.     pout->x = tp.x / tp.w;
  93.     pout->y = tp.y / tp.w;
  94.     pout->z = tp.z / tp.w;
  95.     } else {
  96.     *pout = *(Point3 *)&tp;
  97.     }
  98.     return tp.w;
  99. }
  100.  
  101. /* 
  102.  * Pt3ToPt4: convert 3-vectors to 4-vectors by padding with 1.0 's.
  103.  *
  104.  * Charlie Gunn
  105.  * Nov 26, 1991: originally written
  106.  */
  107.  
  108. void
  109. Pt3ToPt4(v3, v4, n)
  110. Point3 *v3;
  111. HPoint3 *v4;
  112. int n;
  113. {
  114.   register int i;
  115.   for (i = 0; i<n; ++i)    {
  116.     *(Point3 *)&v4[i] = v3[i];
  117.     v4[i].w = 1.0;
  118.   }
  119. }
  120.  
  121. void
  122. HPt3ToPt3(hp, p)
  123.      HPoint3 *hp;
  124.      Point3 *p;
  125. {
  126.   if(hp->w == 1.0 || hp->w == 0.0) {
  127.     *p = *(Point3 *)hp;
  128.   } else {
  129.     p->x = hp->x / hp->w;
  130.     p->y = hp->y / hp->w;
  131.     p->z = hp->z / hp->w;
  132.   }
  133. }
  134.  
  135. /* also need an in-place dehomogenization routine which
  136. sets the w-coordinate to 1.0, unless the original one is zero */
  137. void 
  138. HPt3Dehomogenize(hp1, hp2)
  139.     HPoint3 *hp1, *hp2;
  140. {
  141.   float inv;
  142.   if (hp1->w == 1.0 || hp1->w == 0.0) {
  143.     if (hp2 != hp1) *hp2 = *hp1; 
  144.     return; }
  145.   /* else if ( || hp->w == 0.0) hp->w = .000001;*/    
  146.   inv = 1.0 / hp1->w;
  147.     hp2->x = hp1->x * inv;
  148.     hp2->y = hp1->y * inv;
  149.     hp2->z = hp1->z * inv;
  150.     hp2->w = 1.0;
  151. }
  152.  
  153. void
  154. HPt3SubPt3(register HPoint3 *p1, register HPoint3 *p2, register Point3 *v)
  155. {
  156.     if(p1->w == p2->w) {
  157.     v->x = p1->x - p2->x; v->y = p1->y - p2->y; v->z = p1->z - p2->z;
  158.     } else if(p1->w == 0) {
  159.     *v = *(Point3 *)p1;
  160.     return;
  161.     } else if(p2->w == 0) {
  162.     *v = *(Point3 *)p2;
  163.     } else {
  164.     float s = p2->w / p1->w;
  165.     v->x = p1->x*s - p2->x; v->y = p1->y*s - p2->y; v->z = p1->z*s - p2->z;
  166.     }
  167.     if(p2->w != 1)
  168.     v->x /= p2->w, v->y /= p2->w, v->z /= p2->w;
  169. }
  170.     
  171.     
  172.